|
Code location |
Code |
Model object |
Details |
|
1 |
/*
|
|
Nonfunctional code (Comment) |
|
2 |
* File: Autopilot.c
|
|
Nonfunctional code (Comment) |
|
3 |
*
|
|
Nonfunctional code (Comment) |
|
4 |
* Code generated for Simulink model 'Autopilot'.
|
|
Nonfunctional code (Comment) |
|
5 |
*
|
|
Nonfunctional code (Comment) |
|
6 |
* Model version : 1.152
|
|
Nonfunctional code (Comment) |
|
7 |
* Simulink Coder version : 8.5 (R2013b) 08-Aug-2013
|
|
Nonfunctional code (Comment) |
|
8 |
* C/C++ source code generated on : Mon Feb 03 08:13:57 2014
|
|
Nonfunctional code (Comment) |
|
9 |
*
|
|
Nonfunctional code (Comment) |
|
10 |
* Target selection: ert.tlc
|
|
Nonfunctional code (Comment) |
|
11 |
* Embedded hardware selection: 32-bit Embedded Processor
|
|
Nonfunctional code (Comment) |
|
12 |
* Code generation objectives: Unspecified
|
|
Nonfunctional code (Comment) |
|
13 |
* Validation result: Not run
|
|
Nonfunctional code (Comment) |
|
14 |
*/
|
|
Nonfunctional code (Comment) |
|
15 |
|
|
Nonfunctional code (Empty line) |
|
16 |
#include "Autopilot.h"
|
|
Not processed (Include statement) |
|
17 |
#include "Autopilot_private.h"
|
|
Not processed (Include statement) |
|
18 |
|
|
Nonfunctional code (Empty line) |
|
19 |
const slBus1 Autopilot_rtZslBus1 = {
|
|
- |
|
20 |
0.0, /* altRate */
|
|
Not processed |
|
21 |
0.0, /* alpha */
|
|
Not processed |
|
22 |
0.0, /* beta */
|
|
Not processed |
|
23 |
0.0, /* airspeed */
|
|
Not processed |
|
24 |
0.0 /* alt */
|
|
Not processed |
|
25 |
} ; /* slBus1 ground */
|
|
Not processed |
|
26 |
|
|
Nonfunctional code (Empty line) |
|
27 |
const slBus2 Autopilot_rtZslBus2 = {
|
|
- |
|
28 |
0.0, /* phi */
|
|
Not processed |
|
29 |
0.0, /* theta */
|
|
Not processed |
|
30 |
0.0, /* psi */
|
|
Not processed |
|
31 |
0.0, /* p */
|
|
Not processed |
|
32 |
0.0, /* q */
|
|
Not processed |
|
33 |
0.0 /* r */
|
|
Not processed |
|
34 |
} ; /* slBus2 ground */
|
|
Not processed |
|
35 |
|
|
Nonfunctional code (Empty line) |
|
36 |
/* Block states (auto storage) */
|
|
Nonfunctional code (Comment) |
|
37 |
D_Work_Autopilot Autopilot_DWork;
|
|
Not processed |
|
38 |
|
|
Nonfunctional code (Empty line) |
|
39 |
/* External inputs (root inport signals with auto storage) */
|
|
Nonfunctional code (Comment) |
|
40 |
ExternalInputs_Autopilot Autopilot_U;
|
|
Not processed |
|
41 |
|
|
Nonfunctional code (Empty line) |
|
42 |
/* External outputs (root outports fed by signals with auto storage) */
|
|
Nonfunctional code (Comment) |
|
43 |
ExternalOutputs_Autopilot Autopilot_Y;
|
|
Not processed |
|
44 |
|
|
Nonfunctional code (Empty line) |
|
45 |
/* Model step function */
|
|
Nonfunctional code (Comment) |
|
46 |
void Autopilot_step(void)
|
|
- |
|
47 |
{
|
|
Nonfunctional code (Start of code segment) |
|
48 |
/* local block i/o variables */
|
|
Nonfunctional code (Comment) |
|
49 |
real_T rtb_phi;
|
|
Local variable declaration |
|
50 |
real_T rtb_theta;
|
|
Local variable declaration |
|
51 |
real_T rtb_q;
|
|
Local variable declaration |
|
52 |
real_T rtb_r;
|
|
Local variable declaration |
|
53 |
real_T rtb_airspeed;
|
|
Local variable declaration |
|
54 |
real_T rtb_psi;
|
|
Local variable declaration |
|
55 |
real_T rtb_p;
|
|
Local variable declaration |
|
56 |
real_T rtb_alt;
|
|
Local variable declaration |
|
57 |
real_T rtb_altRate;
|
|
Local variable declaration |
|
58 |
|
|
Nonfunctional code (Empty line) |
|
59 |
/* BusSelector: '<Root>/Bus Selector4' incorporates:
|
|
Nonfunctional code (Comment) |
|
60 |
* Inport: '<Root>/Inertial'
|
|
Nonfunctional code (Comment) |
|
61 |
*/
|
|
Nonfunctional code (Comment) |
|
62 |
rtb_phi = Autopilot_U.Inertial.phi;
|
|
- |
|
63 |
rtb_psi = Autopilot_U.Inertial.psi;
|
|
- |
|
64 |
rtb_p = Autopilot_U.Inertial.p;
|
|
- |
|
65 |
rtb_theta = Autopilot_U.Inertial.theta;
|
|
- |
|
66 |
rtb_q = Autopilot_U.Inertial.q;
|
|
- |
|
67 |
rtb_r = Autopilot_U.Inertial.r;
|
|
- |
|
68 |
|
|
Nonfunctional code (Empty line) |
|
69 |
/* BusSelector: '<Root>/Bus Selector3' incorporates:
|
|
Nonfunctional code (Comment) |
|
70 |
* Inport: '<Root>/Air Data'
|
|
Nonfunctional code (Comment) |
|
71 |
*/
|
|
Nonfunctional code (Comment) |
|
72 |
rtb_alt = Autopilot_U.AirData.alt;
|
|
- |
|
73 |
rtb_altRate = Autopilot_U.AirData.altRate;
|
|
- |
|
74 |
rtb_airspeed = Autopilot_U.AirData.airspeed;
|
|
- |
|
75 |
|
|
Nonfunctional code (Empty line) |
|
76 |
/* ModelReference: '<Root>/Roll_Autopilot' */
|
|
Nonfunctional code (Comment) |
|
77 |
roll_ap(&rtb_phi, &rtb_psi, &rtb_p, &rtb_airspeed, &Autopilot_U.APeng,
|
|
- |
|
78 |
&Autopilot_U.HDGmode, &Autopilot_U.HDGref, &Autopilot_U.TurnKnob,
|
|
- |
|
79 |
&Autopilot_Y.AileronCmd, &(Autopilot_DWork.Roll_Autopilot_DWORK1.rtb),... |
|
- |
|
80 |
&(Autopilot_DWork.Roll_Autopilot_DWORK1.rtdw), 1.0, 1.0, 3.0, 0.015);
... |
|
- |
|
81 |
|
|
Nonfunctional code (Empty line) |
|
82 |
/* ModelReference: '<Root>/Pitch_Autopilot' */
|
|
Nonfunctional code (Comment) |
|
83 |
pitch_ap(&rtb_phi, &rtb_theta, &rtb_q, &rtb_r, &rtb_alt, &rtb_altRate,
|
|
- |
|
84 |
&rtb_airspeed, &Autopilot_U.APeng, &Autopilot_U.ALTMode,
|
|
- |
|
85 |
&Autopilot_U.ALTRef, &Autopilot_U.PitchWheel,
|
|
- |
|
86 |
&Autopilot_Y.ElevatorCmd,
|
|
- |
|
87 |
&(Autopilot_DWork.Pitch_Autopilot_DWORK1.rtb),
|
|
- |
|
88 |
&(Autopilot_DWork.Pitch_Autopilot_DWORK1.rtdw), 2.0, 0.5, 2.0);
|
|
- |
|
89 |
|
|
Nonfunctional code (Empty line) |
|
90 |
/* ModelReference: '<Root>/Yaw_Damper' */
|
|
Nonfunctional code (Comment) |
|
91 |
yaw_damper(&rtb_phi, &rtb_r, &rtb_airspeed, &Autopilot_U.APeng,
|
|
- |
|
92 |
&Autopilot_Y.RudderCmd, &(Autopilot_DWork.Yaw_Damper_DWORK1.rtb),
|
|
- |
|
93 |
1.0);
|
|
- |
|
94 |
}
|
|
Nonfunctional code (End of code segment) |
|
95 |
|
|
Nonfunctional code (Empty line) |
|
96 |
/* Model initialize function */
|
|
Nonfunctional code (Comment) |
|
97 |
void Autopilot_initialize(void)
|
|
- |
|
98 |
{
|
|
Nonfunctional code (Start of code segment) |
|
99 |
/* Registration code */
|
|
Nonfunctional code (Comment) |
|
100 |
|
|
Nonfunctional code (Empty line) |
|
101 |
/* states (dwork) */
|
|
Nonfunctional code (Comment) |
|
102 |
(void) memset((void *)&Autopilot_DWork, 0,
|
|
- |
|
103 |
sizeof(D_Work_Autopilot));
|
|
- |
|
104 |
|
|
Nonfunctional code (Empty line) |
|
105 |
/* external inputs */
|
|
Nonfunctional code (Comment) |
|
106 |
(void) memset((void *)&Autopilot_U, 0,
|
|
- |
|
107 |
sizeof(ExternalInputs_Autopilot));
|
|
- |
|
108 |
Autopilot_U.AirData = Autopilot_rtZslBus1;
|
|
- |
|
109 |
Autopilot_U.Inertial = Autopilot_rtZslBus2;
|
|
- |
|
110 |
Autopilot_U.HDGref = 0.0;
|
|
- |
|
111 |
Autopilot_U.TurnKnob = 0.0;
|
|
- |
|
112 |
Autopilot_U.ALTRef = 0.0;
|
|
- |
|
113 |
Autopilot_U.PitchWheel = 0.0;
|
|
- |
|
114 |
|
|
Nonfunctional code (Empty line) |
|
115 |
/* external outputs */
|
|
Nonfunctional code (Comment) |
|
116 |
Autopilot_Y.AileronCmd = 0.0;
|
|
- |
|
117 |
Autopilot_Y.ElevatorCmd = 0.0;
|
|
- |
|
118 |
Autopilot_Y.RudderCmd = 0.0;
|
|
- |
|
119 |
|
|
Nonfunctional code (Empty line) |
|
120 |
/* Model Initialize fcn for ModelReference Block: '<Root>/Pitch_Autopilot' */
... |
|
Nonfunctional code (Comment) |
|
121 |
pitch_ap_initialize(&(Autopilot_DWork.Pitch_Autopilot_DWORK1.rtb),
|
|
- |
|
122 |
&(Autopilot_DWork.Pitch_Autopilot_DWORK1.rtdw));
|
|
- |
|
123 |
|
|
Nonfunctional code (Empty line) |
|
124 |
/* Model Initialize fcn for ModelReference Block: '<Root>/Roll_Autopilot' */
|
|
Nonfunctional code (Comment) |
|
125 |
roll_ap_initialize(&(Autopilot_DWork.Roll_Autopilot_DWORK1.rtb),
|
|
- |
|
126 |
&(Autopilot_DWork.Roll_Autopilot_DWORK1.rtdw));
|
|
- |
|
127 |
|
|
Nonfunctional code (Empty line) |
|
128 |
/* Model Initialize fcn for ModelReference Block: '<Root>/Yaw_Damper' */
|
|
Nonfunctional code (Comment) |
|
129 |
yaw_damper_initialize(&(Autopilot_DWork.Yaw_Damper_DWORK1.rtb));
|
|
- |
|
130 |
|
|
Nonfunctional code (Empty line) |
|
131 |
/* Start for ModelReference: '<Root>/Pitch_Autopilot' */
|
|
Nonfunctional code (Comment) |
|
132 |
pitch_ap_Start(&(Autopilot_DWork.Pitch_Autopilot_DWORK1.rtdw));
|
|
- |
|
133 |
}
|
|
Nonfunctional code (End of code segment) |
|
134 |
|
|
Nonfunctional code (Empty line) |
|
135 |
/*
|
|
Nonfunctional code (Comment) |
|
136 |
* File trailer for generated code.
|
|
Nonfunctional code (Comment) |
|
137 |
*
|
|
Nonfunctional code (Comment) |
|
138 |
* [EOF]
|
|
Nonfunctional code (Comment) |
|
139 |
*/
|
|
Nonfunctional code (Comment) |